

#include <math.h>
#include "tf_Geom_Algorithm.h"



double getTowPointDis(double pt1[3],double pt2[3])
{
	double dist;
	double vec[3];
	
	vec[0] = pt1[0] - pt2[0];
	vec[1] = pt1[1] - pt2[1];
	vec[2] = pt1[2] - pt2[2];
	
	dist = sqrt( vec[0]*vec[0] + vec[1]*vec[1] + vec[2]*vec[2] );
	
	return dist;
}

double getTowPointDis(TfPoint pt1,TfPoint pt2)